/*
 * VehiclePath.cpp
 *
 *  Created on: Mar 26, 2013
 *      Author: ohnozzy
 */
#include "VehiclePath.h"
void flyingcamera::base::VehiclePath::getState(double t, double& x, double& y,  double& vx, double& vy) const{
     double  x1, y1;
     double tempYaw;
     getLocation(t, x, y, tempYaw);
     if(t-delta_t>0){
       getLocation(t-delta_t, x1, y1, tempYaw);
       vx=x-x1;
       vy=y-y1;
     }else{
    	 getLocation(t+delta_t, x1, y1, tempYaw);
    	 vx=x1-x;
    	 vy=y1-y;
     }
}



